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Background In 


■ The Satellite Servicing Capabilities 
Office (SSCO) is currently developing 
and testing Goddard’s Natural Feature 
Image Recognition (GNFIR) software 
for autonomous rendezvous and 
docking missions 

■ GNFIR has flight heritage and is still 
being developed and tailored for future 
missions with non-cooperative targets 

DEXTRE Pointing Package System on 
the International Space Station 

- Relative Navigation System (RNS) on the 
Space Shuttle for the fourth Hubble 
Servicing Mission (shown in figure) 
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How GNFIR V\ 



Receive camera imagery 


Use gradient filter to obtain gray-scale 
image 


Project an a priori pose estimation of 
an edge into the image frame 


Segment the edge into control points 


Perform a search in the predicted 
edge normal direction 


Use a least squares fit to minimize 
search distances 
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Concept and 


■ 


■ Hypotheses: 

A metric of the target vehicle’s pose observability can be determined (prior 
to receiving imagery) solely as a function of the target’s edge model and 
planned trajectory 

- Certain parameters used in the Lie Algebra of GNFIR’s edge-fitting 
algorithm will serve as a useful quality metric of the state estimation error 

■ Motivations: 

- Geometry-based quality metric 

■ Used in relative navigation filter (RNF) to weight state estimates 

■ Analog metric, as opposed to the binary metric currently used (edges found vs. 
expected) 

- Tool for creating better models and trajectories 

■ Computationally efficient method can be used in Monte Carlo analysis to improve 
overall system performance 
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Lie Algebra E 


c,=Y.fif; 

4 


f, = W* 

v,=Z^ 

4 



Equations and figure from 
Drummond and Cipolla 
(see ref’s slide) 


Variables 

Cjj : projection matrix mapping the observed edges to the model 

Lj : true image coordinates of features w.r.t. the i th Lie group 
generator 

n : edge normal direction (see figure) 

fj! edge-normal motion observed w.r.t. the i th Lie group generator 

d : scalar distance from control point to detected edge (see figure) 

V; : vector displacements projected into tangent space 

O; : linear approximation of the state residuals which minimizes the 
error between the model and observed edges 

* C 1 is the candidate for the observability metric «- 
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Strategy 


■ Simplify the problem 

Take away degrees-of-freedom (DOF) to a level which is more easily 
conceptualized 

- Manually derive the nonlinear measurement equations 

Linearize these equations and apply standard least squares estimation 

- Disturb relevant parameters and observe resulting observability trends 

■ Expand knowledge to the full 6DOF problem 

- Make connections between simplified and 6DOF parameters 

- Verify that the same trends in observability are detected 

■ Identify how the exploits can be used to enhance the model and 
trajectory formulation 
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Simplified Pro 


■ Flat plane aligned in roll direction (p^ to camera 

■ Movement constrained to 3DOF: p 1f p 2 , 0 

■ Arbitrary number of edge features (e) at arbitrary distances from center of 
model 

■ Measurements are the angular differences (Acp) between a priori and 
measured edges (similar to “d” in comprehensive problem) 
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Simplified P 


Nonlinear 

Measurement 

Equations: 


6>) = arccos(v/3,) 


s,=P + e,= 

Pi 

+ R X (0) 

e a 


Pi 


_ e i,2 _ 


(fiXP, 6) = arccos( 


p x + e l j cos 0- e . 2 sin # 


a/(A + 1 cos <9- e f 2 sin <9) 2 + (/? 2 + ” sin <9- e . 2 cos <9)" 



Pi 

A 
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Simplified Pro 


Define model by number and location of edges 


Model: 


■ Provide random a priori state close to truth state 

■ Generate measurements (z) on each edge using nonlinear equations and 
zero-mean Gaussian white noise (v) 

■ Compute linearized projection matrix (H) to satisfy: 

z = Hx + v 
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Simplified Pr 


Estimation 


Linearize equations about the 
a priori state: 


Pl Pi, a + APl 

Pi -> A,a + Aft 
0^>0 a +A 0 


Derive projection matrix (H): H = 

dAx 


A x = (H T H)~ 1 H T z 


■ Obtain state estimate: 

/V 
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P\,a 

i 
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Simplified Pr 



f Concept 


■ Hypothesis: 

- Model is more observable when features are spread farther apart - i.e. better geometry 


■ Test: 

- Use 3 edges per model (to be fully observable) 

- Slide the middle edge between the top and bottom edge 

- Average over 100 cases with different measurement noises and a priori 
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Models: 
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Simplified P 

1(1 | -oof of Concept 
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■ Observability is best when the 
edge features are most spread 
out (model 6) 

- True for both position DOF’s (top) 
and attitude DOF (bottom) 
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■ Proves that this model behaves 
as expected and is an 
appropriate representation of 
the 6DOF problem 

- Trends in observability and 
estimation error should be 
comparable 
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Simplified P 


in 5 Observability vs. RMS Error by Model 
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■ Each DOF portrays a linear 
relationship between the 
observability and the 
estimation errors 

Comparing component-by- 
component 
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■ Should expect to see this 
same correlation in the 6DOF 
representation 
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Expanding to 


Simplified problem: AX = (H T H) X H T Z 


Full problem: 


«, =C:V, *(/•/)-' •(/•</) 


*We should see 
the same trends in 
C 1 as those in 
HTHI 


Parallel to GDOP: 


Q = U T l) 1 
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PDOP = JcP x +cP y + (K 


NAVIGATION & MISSION DESIGN BRANCH, CODE 595 

NASA GSFC 


15 


6D0F Models 



■ GOES-12 FSAB Models 

- From left-to-right models should have less observability (less features) 

■ Trajectory involves range span from 4m to 2m 
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X Component of C inverse vs X Error 
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Y Component of C inverse vs Y Error 
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■ Each DOF portrays the 
same linear relationship 
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Verifies that the 
parameters from the 
simplified model are 
accurately comparable to 
the 6DOF model 
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Conclusions 



■ Results look very promising to continue with plans to derive a quality 
metric and tool for generating better models 

■ More work to be done in characterizing the linear relationship 

- Add more models to see if trend continues 

- Ballpark of “good vs. bad” numbers 

- How this ties into the RNF 

■ Will look at a test case and predict performance prior to looking at 
imagery, then compare to what metric predicted 

- Further fine-tune the predictions 

■ Need to generate a feature-by-feature representation of the plots to pick 
out which to keep/discard 

■ Perform Monte Carlo analysis using synthetic imagery to optimize the 
trajectory and/or model for a given scenario 

- Presumably by minimizing C _1 over the entire trajectory 
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Thank you for your time. Questions? 
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